Listing of Claims 



CLAIMS 

1. (Currently Amended) A system for estimating the position, yetocjiy and 
orientation of a vehicle, comprising: 

- means for determining the components of two noncollinear constant unit 
actors gb ,e b according to vehicle body axes^sa jdmeans including : 




body^axes^nd at least three acc elermieters^^ 
body axes to provide th* forge g< in body ay fiS; 

^ggnetometer able to meas ure the Earth's m^ ^j^, 

a ccording to the vehicle body ayp R; 

^atic pressure and different^. presstirPj ^rc 

r tW ° Vanes to measure th^ »n^ s of attank anH QiHa ^ 

= J * D - a ^ ular ve| octy ac qu isit ion and process jn g_module configured 

t^acquM^ the angular velor ^^ (0 ang^gladL^b^^fr - r) ; 

^data_ acquisition and pro cessing module conf ^ ^Lncguirc 
^^^^-^ 

BB§§yiS-A(0_r neasured in se n sor, the differ.nti,,^ ^^^ 
^^^^^ 
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body axes v„(t-r) as follows: 





V COS CC COS /? 




v sin /? 




C sin a cos /? 



the numerical derivative of the air velocity in body axes v b (t-r) ± 
the local gra vity in body axes ff r as follows: 

g h (t - r) = y A (f - T ) + - r) x y /; (7 - r ) -a h {t-r) 

and the projection of the Eart h's magnetic field on the horizontal plans 
perpendicul ar to local gravity gQ-r) as follows: 

e,(r - r) = - T ) - fh b (t - r) ■ . §b(t - T \ ; 

M'-r)| 

a GPS receiver means for determining the components of said 
noncollinear constant unit vectors M according to the Earth's axes; wherein 
the data provided by the GPS are acqu i red, processed and used in the H*t a 
acquisition and processi ng module to calculate said components g ? ; a«d 

means for determ i ning tho thfee ^mpn n n nh nf thr n ng u br v o | ocit y Wfe 

of tho vohiclo in body axoo; 
wherein the system comprises 

a mod u'e m e ans for correcting said angular velocity & b with a correction 
u m and obtaining a corrected angular velocity & b = & h + U(0 ; 

a module for integrating the kinematic equations of the vehicle receiving 
the corrected angular velocity S b as input and providing the transformation matrix 
B for transforming Earth's axes into vehicle body axes and the orientation of the 
vehicle in the form of Euler angles 6 ; 

a synthesis module of the components in body axes of the two 
noncollinear constant unit vectors to provide an estimation of said noncollinear 
vectors in body axes § b ,e b , where said estimation is calculated as follows: 
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a control module implementing a control law to calculate said correction 
u a , where said control law is: 

u <o= cr (§ b xg b +e b xe h ) [1] 
where a is a positive scalar, 

such that by applying this correction „. to the measured angular velocity 5> h and 

using the resulting angular velocity «, b =3 b+ u a as input to the module for 

integrating the kinematic equations, the latter are stable in the ISS sense and the 

error in the estimation of the direction cosine matrix B and of the Euler angles O 
is bounded. 

2. (Previously Presented) The system according to claim 1, wherein said 
noncolhnear unit vectors g,e are local gravity g and projection of the magnetic 
field on the plane perpendicular to gravity e . 

Claims 3 and 4 (Canceled). 



5. (Currently Amended) The system according to claim 1 3, wherein the 
system includes a Savitzky-Golay filter (4*9) where numerical derivative of 
v h , is calculated. 

6. (Currently Amended) The system according to claim 1 including: 

" "**w» "f in quiring data from a gr o up o f sensofs located in tho vehic l e, 
pr o viding positi o n and spocd according to Earth's axes P tMtr 

o f Jc q uir o d data -frem n n o thor group of ^ereofs- locatod in th e 
vehiclo, providing specific forco 5, i n body axos; 

a navigation module where the navigation equations of the vehicle are 
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integrated from the specific force a b and the direction cosine matrix B to obtain 
calculated position and velocity speed in local axes and corrected in a Kalman 
filter to obtain estimated position and yejocity-speed in local axes. 
7- (Currently Amended) A method for estimating the position, velocity and 
orientation of a vehicle comprising: 

calculating the components of two noncollinear constant unit vectors g b ,e b 
according to vehicle body axes from measurements of sensors located in the 
veh,cle according to the body axes of the latter, said calculation compiising: 

- measuring specific force a b (t) in body axes static pressure p M x 
differential pressure j^Q , angle of attack a(t) , angle of gjdesjjp . /5(Q^d 
the value of the Earth's m agnetic field m.r.v 

- calculating the true airspeed jjT Tfrom the differential pressure 



PAQ and static pressure j^Q measurements and from knowinci the 
out side temperature at the initial mompnt r : 

calculating the air veloc ity in body a xes as follow*- 



V;, = 



o cos cc cos (3 

v sin p 
v sin a cos p 



delaying a time r_ the angular ve Jocity_^(Q , specific force x 

magnetic field mjj^ and air velocity in hoH y avQg f fr) . 




- calculating the pr oject ion of the Earth's magnetic field on tho 

-1+^.1 — I ... ' 



horizontal plane perpendi c ular to local g ravity as follows- 

e b (t-r) = m b (t-T)-m b (t-T).-M^ll- 

. \§ b (t-T)\ X 



calculating the components of said noncollinear constant unit vectors 
M, according to the Earth's axes from measurements of sensors located in the 
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vehicle which provide position in teeal Earth-fixed axes; 

measuring the three components of angular velocity 3 b of the vehicle in 
body axes; 

correcting the angular velocity 5> h with a correction u a and obtaining a 
corrected angular velocity a> h = a b +u a ; 

integrating the kinematic equations of the vehicle, according to the 
corrected angular velocity <b b and providing the transformation matrix B for 
transforming the Earth's axes into vehicle body axes and the orientation of the 
vehicle in the form of Euler angles 6 ; 

calculating an estimation of the components in body axes of the two 
noncollinear constant unit vectors g b ,e b , where said estimation is calculated as 
follows: 

it = Bg, 

obtaining the correction u m by means of the control law: 

u „ =o-(g b xg b +e h xe h ) [1] 
where a is a positive scalar, 

such that upon applying this correction u„ to the measured angular velocity 3 b 

and using the resulting angular velocity 3 b =3 b+ u a as input to the module for 

integrating the kinematic equations, the latter are stable in the ISS sense and the 

error in the estimation of the direction cosine matrix B and of the Euler angles 6 
is bounded. 

8. (Previously Presented) The method according to claim 7, wherein said 
noncollinear unit vectors g,e are local gravity g and projection of the magnetic 
field on the plane perpendicular to gravity e . 

Claims 9 and 10 (Canceled). 
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11. (Currently Amended) The method according to claim 7 9, wherein v b , the 
numerical derivative of v b , is calculated in a Savitzky-Golay filter (479). 

12. A method according to claim 7 including: 

measuring pnr .i tinn nnH op oo r| j n E Jt -th f i * c d axcc P ,,!/,; 

measuring specific forco S h in body ax o o; 

integrating the navigation equations of the vehicle according to the specific 
force a„ and the direction cosine matrix B to obtain the calculated position 
and velocity speed-in local axes and they are corrected in a Kalman filter 
to obtain estimated position and velocity spee4 in local axes. 
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